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Chapter 


INTRODUCTION 


. • - volves interaction with 

The cw i^ ra ” ,C ^^^^fs^wractitw^corai*^ ot^the secont^'(P 0 ^^|^ 1 ^ 0 ^ 

-=-S=x fSsss-ssss 

of ' he -23r«* Hybrid Postno ^orae ^ lmpeli ance Com^i^ ^ 

C °Ts ffn e Controi ISAUO), ""tions on these »*W~ J, t,emonstr,ion 

l®^£3E2s*« 

also be found ® ^ will be important for tnsunc ^ task to make «e 

of P the manipulator technology a , s Langley Research Center 

an achievable rese arch jointly funded by N 

This report discusses 
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and DARPA, » ^ ,1‘of 

s - - - - 

to a manipulator ctesife 

^transiatton option an,-.— i n t o Sra dcand,na m ,c^ m 

- the performance ^ ^ , hrough testing u, ensure it meets » 

3) tys tem 'perfonnance specifications. ^ ^ the majori ,y of our ex- 

Ctapter * 

performance specificatio - define requirements o manipu lator systems^ 

rSS 6° C^Tfi,fii,-- : “-S^-,ons for fudfier researcfi. to 
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Chapter 2 

DESIGN methodology 

The design approach « fp^e^e^^ 

the user is able » ^f^S/performanee. used as a means 

This specification in ce objectives can be - nitch-axis response, 

process, unambiguous perf«n^,s Specifying, for e-cample.P- ^ sysIem 

of unifying the subsys b an<Jwidlh, etc., allows ear V compliance with design 

terms of step response band in terro s o c ° P , ead to a concise 

SrssS^£SS=s:.--“S 

accomplish this, two goals „ scr /umiuW 

1 • "Z % manipulator P^Z i ' 1 "’ “ M ' V ‘ OT ‘’' * 

pr«.vai m J “remove a module ,or , 

exist for transforming 

namic specifications. inu iator systems to he tested for corn 

■ sffj^^S5i=s:SKM-- 

j'SSS— a .... 

In section 2.1, a candidate app ^ ^ sh „wn in F ‘*^ , hc role of these 
This focuses on the ^nctional and performance ^ desig „, and final 

^ --r Snr^«® 

in section 2.1 also addresses 

, reducing the basic «*«P£ o{ the proposed <«h«^ tWs design approach^ 

— 

- - - sysKms ' 

as a common basis tor p 



0#»t9" 

R«qulr«d ^ 

lmp *Uoo.» 



Control 

D«*^ n 




f^edtnott 

. , 2V General Design Methodology 

Figure 2 -i. 


nit ipncf o 

F ‘ 8 “ . for manipulator system 

. Misting techniques for man i> 

ndteleoperated systems, and etctsti t 

and autonomous and teleop 
performance valtdatton. 

I i r,.e| 0 11 Methodology Prom a 

21 Genera ' DC 8 h des , gn ro ethodotogy is shown analysis 
The overall structure for 1 e me ihodology '« lhe e ” SK "J' wing designers and an- 

« "I the to sur, 

*- are 

described further in sect 

Mi DeSig " Resign process are listed below 

Th e hey steps » «•» <* ^ance ^irentents 

, Derivation of a complete se P , requirements P and acceler- 

iem based on an «■»££, such as peak force a d »J^ cif , ca ,ion of dynam.c 

'" dUde rrS mobility, worh — ; impedance. 

atton, accu . y t case end ..wished requrre- 

perfonnance m terms bas ed ^ (he estabbshed 4 

r , nreliminary des.gn conoep ' auribute s necessary to 

2 . Development of P reflects baste ,y- 

mpnts. Uestjp 11 ’ 
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design specifications £ 

" tzEZzz - a,iow for 8realer 

requirement and moddy tne y 

inaccuracies. development of high fidelity digital 

, Detailed system and ' V*?,* ^ ^ 

—-irrr, elements in terms 

- ^ iS " W " ran0nS 

functional tasks. ft rst an d the last. Outwardly, 

The most important steps ZZ that everyone who has ever attempt^ 

the series of steps that have been 7 , 0 follow. What has not been d • d jn 

to design a manipulator system > - ^ lQ functional recfum™ ■ ^ wil , 

is to effectively relate dynamic P idere(1 sufficient to specify th » 

the firs, step- '""^ 1 ^ hope .ha, the is rha. them 

have a “compliant the syste m is being desig • h>wior a nd a specific 

behavior required for “^ptdator system. The ^T^roWem typically lies in 

^ — can "stem P— Wmgh, constmtnts 

"7 « s^itass 

■hssss ^ 

dynamic requirements are e. evaluated through simu a implies the 

allow initial concepts » * rr^jM ^IZcZ « .he basis 

„f friction, time delay, no.se c d namic performance hb^e ^ but 

niques to automatically ge generated empirically. ability 

•7r 
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*c validation process can be 

rr^ib ^== f 5r 

. _ nn i: ed t o the manipulator end-ettector a f nroC ess — either the manipulator 

ta dy " amic pe “ or 

they don’t ! 

2.1.2 Considerations , 0 f manipulator sys- 

A genera, methodology for the specific , be resolved before such an 
mms was outlined above. While teclm, <t Ussues mma ^ wil h respect to 

approach could be fully ,mplc ^"^ comi „ gs associated with the design of mamptd 
overcoming many of the current shortcom J, ment resources going into the 

Tsvstems With increasingly larger amount such as that described is 

development of these set of design tools in common usage 

essential. Hopefully, t 18 * id conflicting standards, etc. 

by the armed services and NASA to 


2.2 Technical Issues 


lecnn.ca, — ntnjduced . The methodology 

In the previous section a design methodology was irenie ms, the design 

relie s"e ^cts of -his — 

o^nmorc detail.' The derivation ° f The actual design 

fl *e Standpoint of amdytitn ; — ™ ^Jance retirements are used. Ftnally. 

• *• „ nf Dynamic Performance Requirements 

2.2.1 Derivation of y methodology that is being 

The single most important and unique attribute' < he de g ^ ^ with , he 

suggested is the adherence to the *qu uemen uha the d perfomanC e 

™. isrrr - . - 

reC,U Te'static requirements tf these specifications is well 

imnm reach and maximum tip spe ■ (he functional tasks. . 

=cU- - - - ■* - - - 
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, the new position, the number 

the new position, the --^n^ 

£3^ aK key “ emp,oy ’ n8 

— -** “ 

it is difficult and m some cases P nafy desig „ stage. m approach the pre- 

the available options dun g , mc requirements it is P ■ importantly 

Iasss^sssks- ; 

'SZSZZ -- - T ;« s> - “ 

dl all y simple requirement into q ^wem’ Wetave^hosen 

Translating this concep ' J is a very complex I ficalion . The impedance 

following equation of motion, (- 


p = MX + RX 1 - h x • 

7 of the system is defined as 
then the impedance, „ + + K . 

/j 


(2 - 2 ) 


ZS X" „ relate, the dynamic position re- 

The end-effecor 

T^'^" -ample it may ^ m Ih^nd-effector 

C '' d - effcC,W mUS ' ,he " " 

to K <~ 
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7 — K + ^ 8 

. , . „ the end-effector to behave like a mass- 
Thn<; wc are defining the 

along each Cartesian axis. dYna mic performance re- 
spring-damper system^ fo nowed in our investigation d t0 analytically 

Three directions are being insertio n task we have attemp Qnal mis _ 

quirements. Using a very -j 1 ™ complete the task, allowing mi workpiece, 

predict the required impcdwc^ such P dyna mic effects as the menu of t ^ of 

techniques can be emp t jamnling ) is much more dr c insig ht into 

(force direction such t p simple tasks can prov . - ns Empirical 

stressed. Emphasis - funct ional task descriptions, n is show n that one 

developed on the basis ^ design process is expk ^ ^ and dyna mic 

performance spec he. of taving a comp ere r { imeracti o„ 

ss h thal wWch rates ****** 

The system design prtKess rs that w tha , ,he perfonnance reep 

m e„. S anddefine Sa comp>e«^«J mum illitia , a „d htf-cyc e a ^The ^ 

sssssj 

tors which are good at tradit 

- tt&zsr**- — i ” rce J,sc,p ' 

.,i rw™ and Analysis, 




2-6 



. Controller hardware Destfc 

*35? =u “ t 

ssSSSss 


lie U1V — . rr. - s 1S in uti^ w r— . tVl#> 

pplrcatioTs ttwr 1 S °^ W has been and continues to be . per- 

manipulator aes fe *\ is impossible to me requirements. 1 'ie iU 

formttnee require™ ent s « P meet its perf «T> ^t,, wit h the hope that they w 


^SSsss* 

pendance on a 
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"" 1 ‘ ,m ^ effca Of ume delay on actable end- 

„. 0tr ;c plot showing effect tj 
Figu re 2-2: Example parametric pl< 

effector impedance. 

- i ^ Performance Validation C e validation of the com- 

will see in space, here E by dup Ucating them on ^ ^ perform as desired 

. . — - — 

specification, thus ensun g specifications of 

— 1 ” 

the form: p = \J X + BX + X x 


p = MX + BX + X X 


VfiTthe vector of 6 

Vis the vector of 6 nia specifications, 

M is the 6 x 6 di»gon =of damping specifications 

II is the 6 x 6 of stiffness specifications 

K i, the 6 x 6 diagonal matrix 

UirrYlPf 


j IS ui^ ^ ! ^s^trix Ot Silling™ “ r 

K is the 6 x 6 diagonal matrix pe clance specification, 

me to come np with a higher orde f imp iy that the 

It is certainly possible to specification mamux stage „ 

s=s£i:sS- -:s — 
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Figu re2 


figures- ~ 

h .„ed on a second order model 
specifications for aircraft, and many other sys ^ ^ melhod for validating 

“ 

system P e *™j" C m look similar to Figure „ se will be that of the damping an 

Caries, an axis, « hig her frequency respo 

stiffness specification, iculaI . axis, can be 

inertial specification.. manipulator system, along P ^ manipulator is 

=r*»s=ssi : - - - - - “ 

to yield the frequency respo . he actua l frequency 

force input along °" e ^ X \- ch the force/torque source was a . ance specification, to 

For the axis along ^ frequenc y response of th P responses will 

response may be compa adequate. The cross-ax . . Cartesian axes 

ensure the dynamic in the system. In 2 " 4 

give some measure of the co«P must ^ very well attenuate * Testbe d. xhe 

to appear uncoupled, t ese - d . e ff ec tor impedance from ' our ‘ Analyzer to the 
an actual an HP 3562A ^^ force signals, while 

an^ording the appropriate po. 

exciting the end-effector. 
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n f (>n d- effector impedance on Dual Arm Testbed, 
o-d • Example measurement of end ejjcuo / 



Chapter 3 

dual arm testbed 


manipPula,or 

— the man ' Ha,ot confisuration ' 



Figure 3-1: Martin 


Marietta Dual Arm Testbed 
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3.1 Controller Architecture 


... Controller Arm iDuUlt ors have been stripped, 

. . , , Cincinnati Milacron controllers for t e > man cards Martin Marietta 

retaining only" h<= n^uTr' Sri « a MULTIBUS ch*^ The manipula^ 

has implemented a . hica i control architecture, rampos chassis 

tors are controlled using ■* , 80286 computer, housed ! in 4 MU ^ 

single board computers and , comm unicat.ons link (pro ■ ■ 

a „d commuting 1 

being upgraded to Intel o Qne of 3 han d controllers, s PF hierarchical struC - 

execution and te leopert » ^ of ^ control architecture s ° ^ chassi Both 

TSZZXZf - - ■— on comes from 

position and force ee d n t h e manipulator wris s. - d lo se rve 

DOF Force/Torque ^"^ry tasks are to serve as the rfonnwl on 

The control station s P ^ ^ Qf the manipulator coord . ^ contr oller 

as the inter-arm conti o tr ' d motion, the comman s r() inter-arm 

^/xryrrtinated movement. 



Figure 3-2: Controller 


Architecture of Dual Arm Testbed 




3.2 Manipulator Feedback Controller 

The feedback controller for The next level incorporates 

— r is the cartes, an — e, 

“r™ 

ihe rcrrtwwas 

x roller structure commonly used in app " achieving steady-state velocities. In ig 

^ 

The compensator is a <„ response of the mantpn.ator 

^isHncXhoth the velocity and position loops. 


Sensor 
Force/T orques 



T*- .03s 


Figure 3-3: Join t control Mock diagram 
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Figure 3-4: Frequency response of Base join, . 


■ :v.G Hr-St 9 
— G . O ; 

dB 



-320 


v 500 . 02m 


Fioure 3 


Log Hz 

-J; Frequency response of Shoulder join, 
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Figure 3-8: Frequency response of Wrist Roll 2 joint. 

FREQ 
• 12-0 


dB 


-44.0 


FREQ RESP 
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Figure 3-9: Frequency response of Wris, Foil 3 pint. 




Analog World 

Position 

Command 



Figure 3-10: Cartesian 


control loop block diagram 


3.2.2 Cartesian Control ^ a digital c0 „, roller with a 

below 1 Hz for our applications. Impedance Control implementation 

The Cartesian controller uses a ® or ln this strategy the interactton torre* 

an offset commanded Cartesian posit 
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□eg 


r'xd 


6 40 . L ... L 

Y^io'O . 02 m 


1 __1.~ i—*- 


1-i- 


L0 9 


HZ 


Figure 


3-] 1 : Position frequency re , 


sponse for Cartesian 





ox !i a 



Impedance Filter: _ 

Specification Filter is ^ ~ l (3 - 1 ) 

Xi(tii) = Jt« 2 +~ Bw + K 

WherC: F is the force sensed along the i'th Cartesian axis, 



ena-effector behavior will resemble a spring of stiffness / - 


Analog I/O ^ ^ ^ referenc e Cartesian position and the 

Analog input commands may torau es Additionally any of the Cartesian 

. — « — 

end-effector impedance. 
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Chapter 4 


performance requirements 


in otder for manipulators ,o be US 

static and dynamic performance spiral ^ * ' ifications aS peak force, maximum 

completion. The static f these specifications is well known an 

reach and maximum tip speed. 1 he importance r 

they are fairly easy to denve fr0 ^ to specify the transient behavior of 

Dynamic performance requi , for the manipulator, the dynamic 

the manipulator. If one commands a how long it takes to reach 

requirements specify how t at c an stop p in g at the new position, the number 

the new position, the amount of ov ^ determined by the manipulator 

of oscillations after reaching the new P manipulator responds 

dynamic response. XcUfa am key ,0 employing 

XZZZZSZ other £ — ^ , he robot , cs com - 

significance of dynamic performance q Without dynamic reqmremems 

to meaningfully evaluate trade-offs between 

*• errs 

“eerr* Z «be°resu.fing design will be one .bat meets the 

requirements for the minimum cost ! . w hich must be met for an assembly 

" A. a high level there are at least two assembly must be 

task to be successful. First the '" ,erac "° n assemW parls , manipulators or fixtures). 
r"^de"r a ls« be such that the pads to be assembled do no, 

"“Sing this conceptually simple r^uire^nnmo^quatmmfive. ^ 

formance specifications, for specific ta , s ^ cificatio „^ Using end-effector 

end-effector impedance as om quant requi ^ me „ ts j„ terms of easily un- 

impedance allows one to specify -PJ requirements may be specified m terms 
derstood physical quanting Tte end^ q characteristics . For example « may 

of inertial (J), damping (B), and stittnes {), the maximum force 

be specified that fOT ' * 1 '^ong^is direction the maximum stiffness ot the 
allowable at the end-effector is j. s 


1 



-".in t — *" ns ° f the fom 


4 - r 


where: 

‘^equivalent to stiffness, damping, mental parameters, 

S is the Laplace operator. , , ■ the e nd-effector to behave like 

along each Cartesian axis. Thus we wed rimentation accom plished to date 

a -ass-spring-damper sy^F^m ^ ^ sysKm behavior as a sprtng-damper 

we have set J 

combination. followed in our investigation of dynamic P e °^ an “ 

Three directions have been fo attempted to analytically predict 

requirements. Using a very «*£££ ^ complex tasks we have begun £ 
required impedances to accomphs nredict required impedance specifications, 

develop simulation tools to enable us to in an actual work environment, 
complex tasks, such as those which would be m performa nce specifications, 

we are exploring empirical meth stong t hat der i v i n g impedance specifications 
The results from these investigations t damage can be developed 

to satisfy the restriction on maximum applied force ^P analytic techniques can 

easily and can be specified early in the des g P ^ requirem ent on proper force 
be employed to obtain these specification • specify analytically. The resu ts 

direction lo prevent jamming is much ^ insight into the directum 

Empirical studies can re.auvely Quickly 

^^ac^eri^^he^etpdred'impedances for a specific task. 

4.! Analytic Derivation of Performance Requirements 

The ultimate goal of this ^ for Xtm S 

This specific investigation has focuse ^ requirements; and to derive 

rive bounds on impedance specificatmns task and exp erimentally verify the 

impedance requirements for a very F 
approach. 

1 1 1 Analytic Bounds on Impedance Specifications 

Z — Js 2 + Bs + Ii. 
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if c : Q p XA if the maximum 

Assume that the maximum applied force tefore ^tblybecause of accuracy limitations 

*• * - * 

p (i - 3) 


K = 


Fm_ 
AXm 


i — * > » iVI 

, ,V difference between the assembly pans is given by 
" the damping spec, heat. on, B, wil. be 

_ _FW_ ( 4 " 4) 

B " AXm 

.• „ i occtimine a maximum ac- 
• m value for the inertia specification, J, assuming 
Likewise the maximum value to 

celeration difference of AXm, is ^ (4 - 5) 

J ~ AXm . . fnA v 

These maximum values T^cXfoTthis possibility, 

F m > JAXm + b ^ m + K AAm ' 

allowable impedances may be derived force le vels, and the maximum 

Assuming that we know the maximum to bou nd the range of allow 

errors in position, velocity and acceleration ^P^ ^ first step in deriving dynamic 
able impedances for virtually ^ be accoraplishe d fairly early in the conceptua 

crated upon throughout the prehmtnary destgn. 

4.1.2 Planar Insertion Task comp le,ion we took 

the chamfer and enter the slot. ^ ^ u is only neccessary to exam.ne the 

To predict the success or , h aoDlied force at this contact poi . 

ssarsSs? 

slot. If not the peg will stick alo g 
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Figure 4-2: Planar insertion task 
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Figure 4-3 shows the contact point of the peg on the 
acting at this contact point. The impedance of the peg, 
specified as 


Zy = ByS+Ky 
Zz = B Z S i K z . 


chamfer and the various forces 
the Cartesian Y and Z axes is 


(4-7) 

(4-8) 


The chamfer and slot is actual posit, on and 

iK * • - -* - — componenls of ri 

the assembly is misaligned by an amount Y„„- 
The force F y is given by . (4-9) 


j? 


r V 4 - K..AYi 


Y is the peg velocity in Y direction, 

AVr is the Y component of distance peg 
The force F, is likewise given by 


has 


moved along chamfer. 


P z z= + 7v s A Zb, 


(4 - 10 ) 


where: 


A Zb = ZkOb) _ Z{t B ) 



AZ B = Zn(t B ) - Z M- ^ . 

Notice that F y is not explicitly a . funcuoii , of the to b ^ successfully 

a very strong function of .he " £>«£* mus( be such tha , the peg 

completed the reference traje y into tbe s i G t to point E . f p 

complies along the chamfer to pom , ^ as fong as the component of * 

The peg will continue to move alo g component of F y tangential 

irsr;;::-- - — — D ,he 

force F y is increasing, because AY is by a force component normal 

(F XZ222Z * component tangential (*) - - " " “ 
figure 3, these forces are defined as 


Fs = F v cos 0 + I'z si n 0 
Fr = J<\ cos 0 — /',/ sin 0 


(4-11) 

(4-12) 


where: 


0 is the chamfer angle. , a| move along the chamfer m the 

As long as Ft is greater than I to prevent jamming IS then 

correct direction.Recall that !■„ = I ^ 


n(awfl r„(vnt) + i,co S 0) 


,1 conditions for two cases, first 

In examining conditions for jamming we tbe g jamming along the slot 

for the peg jamming along the chamfer and ec along ^ chamfer w fil 

lu v i- „ rt : nt F The greatest possiDimy j At tbe , a mming 

before reaching p " . bi is tbe largest value for ),».»• 

ST . ^^'a^ro, therefore and ft am g,en by 


Fy = 
F, = 


I\ y ^ i ) i i .S 

l< ; (Zn(h) - ^ 


(4-14) 

(4-15) 


(4 - 16) 


The jamming condition may now be wr 

A - ( Z, ? (/./) Zo)(c°s 0 - /' sin 0) = E y V w i,(sin 0 + >'■ COb ^ 

The jamming condition for the peg 'beTuch that the peg would 

lamming,' the direction of the force vect .or at ^ ^ jamra mg it is only nec- 

continue moving into the slot if « cou c . J1 h ^ ^ lhe fric ,ion force is given by 

cessary to look at the force ba an c p ^ There fore to prevent jamming a ong 

p __ \ r . u The tangential torce, / v 
r n — ■* rntsr* , 

Slot it is only neccessary that (4-17) 

[\.(Zn{t /) - Fr;) > 
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for a specific example. For this example 

We will no w derive the jamming conditions for a spe 

0 = 45 


y; 


mis 


Z 


L) 


Z f ’\ to (4-16) the condition to prevent jamming * 
Using the above values and refernnfc ( (4 _ 18) 

' a ' - '‘ )>0X ' 8,U 't7.o P-ent jamming. IIP ^ 

Nonce that there is a re gardless of the ''"j^ons to 

the peg will always an* on ^ u a)so a m i„,mum ratto of 

For a specific vatae ra \\o of K, » K, > s 8 lven “ 

prevent jamming- (4 — 19) 

= 0.684(1 + /0C l - fl < 

Ky . The coefficient of friction is 

The slot and peg both 

unknown s.nce i, is a ^fic finish. " 

— sr see — - > ~ 

a block of — ; ll () , = TONt/ou . l> = 'justed over a small 

impedance was set very .8 ^ •„ the y and Z axe described in the above 

St - : t,rr rTT — ts along the 1 

system for the experiments w . 



b Ml _ cif'r .. n /■■■) N 1 1 rr 


45 ° 

3 .25 cm 
3 .25 cm 
5.00cm 
8.00cm 


V- 

3,: ».= 



0.62 JV't/ cm 

0.085 Ntjcm. 


an 


(4-20) 


experiment is Kjl<; = [1 ^ ? ° V ^ ^ 9 ^ From Figure 4 
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Figure 5 shows the test,., s using .he Mowing Ranees: 

Si - S,Y ' (.■ = 0 62 Nt/crn 

Z„: = h " 


cm 


Nt-sec = 0 15 Nt/crn. 

r/ . fi =1.5 ’ ‘ 2 

6z • cm 

. jn , maximum allowable friction coefficient of fi 
These impedences resi ‘ 

PreVe F “ rL., S using «be following impedances: 


(4-21) 
0.72 to 


7j v : B y 


Nl. - .sec _ o.62 Ni/cm 

= 1.5 — " ’ y 


cm 


Z 2 : Hz 


Nl - .sec = 0 35 jvt/cm. 
r> i j * 


C7'M 


(4-22) 

• r IN = 18 The maximum allowable friction 

fer and into the s o chamfer. 

“ 7 t^“n g the follow, ng impedances: 


Nt - -sec K = l8 Ktjan 

7 . n =3.5 ’ ' a 

/>v • u y an 

Nt — sec ., _ \$ Nil cm. 

7 . r. = 3.5- ’ h * " ' 

zj z ■ l)z an 


(4-23) 

i From Figure 7 it can be seen that the 

The stiffness ratio for Otis fourth =^, men, ^ (a ^ „ that the tacuon 
peg stuck after travelling almost 1 tnch ato t to (4-16), and usmg Ftgt«e 7 

coefficient must be a, leas, „ = 0.19. * £ £ ^ approx ima„on ,0 the fncuon 

should be greater than U>. ^^loTctdeness of the ^ 

.r-rs » >— ■ 
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and it is not possible to generate large tangential 
friction coefficients. 


forces to overcome 


broad range of 
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Figure 4-4: Position and force time histories for h y / h z — 
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Figure 4-5 : Position and force time histories for K y f K z ^ 
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Figure 4-6: Position and force time histories for K y j K~ — 1 .8 
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Figure 4-7: Position and force time histories for K y / 1< Z - 1 
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4.2 Simulation Approach to Performance Requirements 

: --:s;t:irrrri:,‘= 

interaction between the peg c • . bein „ developed as a combination 

— - — — 

4.2.1 Analytical model 

A simplified, planar peg dynamics is described by .he following uncoupled equations of 

frfy _ f _ fl (f l + /. 2 ): translational motion in y direction (;1 24) 

/“ _ Vh _ f.J - fir f x : rotational motion about 0~ 


motion: 


(4-25) 


where: 

M = peg mass. 

I = peg inertia about body O z axis. 
f m z = applied force and moment. 

a = coefficient of friction. WA * • , 9 

f u f 2 = normal forces at contact points = (/v s(l// )(AyJ, 1 - » • 

){ s ' tiJJ = spring stiffness at the contact point. 

= spring deformation at contact point i. 

/ = peg inserted depth. 
r = peg radius. 

Note that the assumptions made here are: 

• peg motion is in the X-Y plane. 

• uncoupled motion. 

• small misalignment angle between peg and hole. 

• rigid peg and hole. 

A very detailed analysis of .he insertion process was given by Whitney in Ref [1], 
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Figure 4-8: Force diagram at two point contact. 


4.2.2 Simulation model 

The insertion simulation is set up using the System Build function in MATRIXx • The 
simulation program contains 4 different user - defined blocks: 

• peg geometry description block. 

• task geometry description block. 

• contact force determination block. 

• peg dynamics block. 

This will allow the user to modify any one of the blocks to tailor the simulation to their 
own particular task. The inputs, outputs, and inter-connection of these blocks are shown 
in figure 2. 

Following is a detailed description of the current implementation in each one of the 
blocks : 

Peg geometry description block 

This block computes the corner point coordinates and edge coefficients in the body frame, 
based on the following inputs: 

• peg initial position relative to the fixed hole frame coordinate. 

• peg length / and width w. 
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. peg angle a and travel distance y from initial position. 

« jrr 

(4-26) 

The edge coefficient /l, II, C are calculated using the line equation that passes 2 
corner points P, (*„!/,). ftt**.*). •» followeil: 

Ax + By + C = 0 


where: 


A = 


if x, f- x 2 

-X| 

1.0 if *1=32 


13 = 
C = 


1.0 if i 1 X 1 

0.0 if a: i = x-i 

-By i — Ax\ if :i'i f l ' 2 
— x 1 if a’i *^2 



Figure 4-9: Flow diagram of the insertion simulation model. 
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Outputs from this block are: 

• corner point coordinates 

• edge coefficient 

Task geometry description block 

Similar to the procedure described for the peg geometry block, except that no coordinate 
transformation is needed. 

Contact force determination block 

This block determines the number of contact points and the appropriate forces /i,/ 2 as 
described in the analytical model section. The distance A y t between a point P x (x u y i) 
and a line Ax + Bx + C = 0 is calculated as followed. 

Ax i + By i + C 
Vl ~ a\/A 2 + B l 

where: 

( +1 if C > 0 
a _ \ -1 if C < 0 

If Ay, < a contact c, which is defined to be l.e-5, then the contact force /, is calculated 
as followed: 

.fi = K s ti jf * Ay; 

Inputs to this block are: 

• peg point coordinates and edge coelficients. 

• task point coordinates and edge coefficients. 

• contact spring stiffness and friction coefficient. 

Outputs from this block are: 

• contact forces / 1? / 2 . 
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Peg dynamics block 

This block determines the translational and rotational motion of the peg. The current 
implementation is shown in figure 3. Inputs to this block are: 

• contact forces /i,/ 2 - 

• applied force f y and moment m z . 

• compliant force j x . 

• peg mass M and inertia I. 

Outputs from this block are: 

• peg translational and rotational distance. 



Figure 4-10: Peg dynamics block. 


This task was pursued to the point where the individual user-blocks were 
At that point it was decided that pursuing empirical techniques for denying 
specifications would be more valuable. 


developed. 

impedance 
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4.3 Empirical Approach to Performance Requirements 


Virtually all of the assembly and other force interaction tasks envisioned for near- 
term applications are too complex to use either analytic or simulation methods to derive 
performance requirements. Instead near-term applications must depend on empinca 

methods for determining impedance specifications. 

For this investigation we chose the task of connecting a candidate truss conn 
for the Space Station. Figure 11 shows this connector. Each half of the connector was 
mounted in one of the robot’s end-effectors. The second robot was again programmed 
to have a very high impedance in all axes (to approximate a ngid attachment), however 
there was an undetermined amount of compliance in the end-effector. The hrst robot had 
very high impedances in the rotational axes, while the impedances of the translational 
axes was varied to find the best set of impedance to accomplish the task. 



Figure 4-11: NASA truss connector used for performance requirements experiments. 

The damping specification of robot I was kept at l.2(i^. With this relatively 
high damping specification it was necessary to use low velocities during the tnser- 
tion/connection tests. Using a high velocity would have resulted in large end. effecto 
forces, due to the damping specification, and it would be difficult to identify the effect 

of changing stiffnesses. . . , , 

To choose the best set of impedances for the task three criteria were considered. 

First the task must be successfully completed. Second we tried to minimize the interface 
forces, and third we looked for a smooth insertion profile, with minimal sticking or 

bouncing 
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4.3.1 Test Setup connector may either be 

Figure 11 shows the connector used for this mode A11 the experiments to 

assembled in a manually locking m e or assembly task since it is not 

date have used the manually locking mo<^ Jhi ^g mechanism. The connector is 
Scessm to overcome the spring force of the self ^ ^ stiU aUo w a smooth 

b ” 

^7::^ 

rnmnletion. 


X Axis Impedance Specification 


4 . 3.2 X Axis irnpeuam-c ^ an aut 0 nO tnous as- 

To find the best impedance spe f fi “T coor dinate offset 1 cm. Various comb, nations 

r: - - « 

Qc«p.mblv recorded. 


Autonomous Path Description ^ ^ experime nts. The connector 

Figure 12 shows the autonomous path used h^ ^ ^ (n (he x direction. The 1 
haWes begin 3.8 cm apart in Z directi ha) f 0 f t he connector was then 

misalignment was made as small as P°f cm/sec in the Z direction, to a position 0.5 cm 
commanded to move at a velocity ° ■ 'alignment was maintained during this en i 

below the fully engaged po««» ‘ ^^maimained for 10 seconds, to allow nans, ants 

Experimental Results for X Mtsahgnm .necihed as 2.7 — and in the 

For the firs, experiment the stiffness in the* ^dtmcnon was im da „ ce requirements, 
^direction as 0.18 £. ensunng the pans don’t jam^The 

that the ratio of stiffness assembly to be successful either 

stiffness 

show the position and force tme ^ st ones or t e ^ ^ makes almost 

Noto in the Z position time ^ “ta. °Te “o Jin the Z directton is very 
no progress towards mating with the other 
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Figure 4-12: Reference path used for X misalignment experiments. 
respectively The X axis shows slightly more compliance (approx 2 mm), with abend 

srAtcisr-SiaTSS.-. 

move towards the mated position. % Hi Figures 

For the third experiment, the stiffness in the Z axis was reduced o L8 _ Figure 

abOUt For 9 the fourth experiment the stiffness in the X axis was reduced to 0.54 Nt/crm 
This corresponds to a stiffness ratio of 0.33. With this set of ^dances : « poss^We 
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we kept the sa m e mtio of stress 

However the "ahtes of both A and z axes From the position 

S hLLriea ,, ,s dear that the connector , tracking the comma dec 1 tra 

cioser This is primarily the result of the increased stiffness in the / axis. The forces 

both axes showas approximate doubling in values - which is just as expected. 

From this series of experiments it appears that, for a maximum possible A axis 
misalignment of 1 cm, the minimum stiffness ratio, K./K, for successful task completion 
' „ „ 8 aclua | s tiffness values will be dependent on the maximum allowable force 
Leis T^fi^ e 'penmen, indicates that to ge, the best performance we s ou d use the 
highest stiffness values possible without exceeding the maximum force limit. . . 
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Figure 4-15: X Axis position and force time histones for expenmen 


4-25 







Fx (Nt) X (meters) 



^ t I I I I . I- .I 1 I I I I ■ *— J » » * « * ■ * — « » * ' 

0 5 10 15 20 25 30 35 

Time (Sec) 


Figure 4-19: X Axis position and force time histories for experiment 4 
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Figure 4-20: Z Axis position and force time histories for experiment 4 
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Fz (Nt) 




Figure 4-22: Z Axis position and force time histories for experiment 5 


4-32 



Figure 4-23: Reference path used for Y axis misalignment experiments. 

4.3.3 Impedance Specification for Y Misalignments 

To investigate impedance specifications for Y axis misalignments, an autonomous assem- 
bly path was generated, with the Y coordinate offset 3 mm. A number of experiments 
were then run, using this path with varying impedance specifications for the first robot. 
The second robot was programmed to have a very large impedance and thus emulate a 
rigid environment, to which one half of the truss connector was mounted. 

Autonomous Path Description 

The autonomous path for Y misalignments is shown in Figure 23. The path begins with 
the upper connector half offset 3 cm above the lower half. The connector is also offset 
3 mm in the Y direction (See Figure 11). The X misalignment was made as small as 
possible. From the starting point the commanded trajectory moves with a velocity of 2 
mm/sec to a point 5 mm below the fully mated position, maintaining the 3 mm Y offset. 
This commanded position was maintained for 10 seconds to allow transients to die out. 
The connector halves were then commanded to separate. 

Experimental Results for Y Misalignments 

The second robot, holding the lower half of the connector, was programmed to have very 
a large impedance in all 6 Cartesian axes. The first robot, holding the upper half of the 
connector was programmed to have a very large impedance about each of the rotational 
Cartesian directions. Therefore, torques in these directions will not cause compliance of 
the end-effector. The damping specification for Robot 1 translational axes was held at 




1.26 Nt ^ ec - This was necessary to ensure adequate stability margin during the assembly 
task. As will be shown in the next section, lower damping levels lead to a severe decrease 
in system stability. 

For the first experiment, the stiffness specifications in the Y and Z axes were set 
at 1.8 and 2.7 respectively. This corresponds to a stiffness ratio, K z /K y , of 1.5. 
Figures 24 and 25 show the position and force time histories for the Y and Z axes 
respectively. From the Z axis response one can observe that the connectors mated fairly 
smoothly, with the actual position tracking the commanded position, until they were fully 
mated. Once the connectors were fully mated there was a low frequency limit sycle of 
approximately 2 mm amplitude. The Z axis force response shows low levels of force 
until the two connector halves are fully assembled. Then, as the reference Z position 
continues to move, to Z = -0.5 cm, the force builds. Also the low frequency position 
limit cycle causes a corresponding oscillation in the force response. The Y axis response 
shows also that the connector complied to the fully mated position of Y = 39.5 cm. The 
Y forces are very small and oscillatory. This data is very consistent with the design of 
the connector. The contact angle, due to Y misalignments, is very small; therefore, the 
connector should easily mate with the stiffness specification given here and generate very 
low forces in the Y direction. 

For the second experiment the stiffness in the Z axis was reduced to 1.8^, resulting 
in K z j K y = 1.0. Figures 26 and 27 show the Y and Z axis time histories, respectively. 
The Y axis response is very similar to that of the first experiment. The Z axis response is 
also similar, although the limit cycles damp out to a much lower amplitude. The decrease 
in Z axis stiffness, and the damped limit cycles are reflected in the force response as 
significantly lower force levels. 

For the third experiment the Z stiffness was further reduced to 0.9 Nt/cm, resulting 
in K z j K y = 0.5. Figures 28 and 29 show the Y and Z axis time histories. The Y position 
response does not show quite as smooth compliance as the earlier experiments, and the 
peak forces are about double those of the first experiment. The Z position response still 
looks smooth and the peak fore levels have again been reduced. 

For the fourth experiment a Y stiffness of 2.7—, and a Z stiffness of 0.54— was 
used. This results in K z fK y — 0.2. Figures 30 and 31 show the Y and Z time histories. 
The Y position move is showing an increased irregularity. The limit cycle after fully 
mating is getting stronger, and as expected the forces are increasing. The Z position 
response is showing a marked lag behind the reference position. Once the connector 
begins moving its trajectory is smooth. The force response shows an initial rise in force 
level until the connector begins moving. The force level then drops until the connector 
is fully mated, when there is another rise. This rise is caused by the difference between 
the fully mated Z position and the reference Z position. The Z position limit cycles also 
cause a corresponding limit cycle in the force response. 

For the fifth experiment the Y stiffness was raised to 4.3^. The resulting stiff- 
ness ratio is 0.125. Figures 32 and 33 show the time histories for the Y and Z axes, 
respectively. Both position time histories show a lag of about 7 seconds. The assembly 
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then proceeds smoothly to the fully mated position. With the increased lag, the Z force 
buildup before movement is larger than in the fourth experiment. . . f 

For the sixth experiment K, was increased to 3.C£. The stiffness ra, to ,s therefore 
now K / Ky = 0.1. Figures 34 and 35 show the Y and Z axis time histones. The lag 
has been increased to 14 seconds, before the connector begins to seat itself. Once it is in 
the fully mated position both the Y and Z position time histones show small amplitude 
erratic movements. With the longer time lag the Z force nses considera y ig er e 

From this series of experiments it is obvious that the ability to successfully mate the 
connector halves is fairly insensitive to the stiffness ratio. In looking back at the diagram 
of the truss connector (Figure 1 1) the reason for this is clear — the contact angle betwee 
the connector halves is very small for Y misalignments. This would indicate that very 
small stiffness ratios would still result in successful task completion. 

As the V' stiffness is increased, the normal force acting at the contact point 
increased This translates directly into an increase in friction force. This is t e cause 
for the lag in the connector movement. The AZ must get larger before the tangentia 
force component of AZAZ will overcome the friction force. Once the connector begi . 
moving the sliding friction is lower than the stiction; also, the contact angle is reduced . 
the connectors hafves are mated. Therefore, once the connector begins moving it quickly 

mates itself to the other half. 

From the above series of experiments, the impedance specifications or experim 
2 clearly stand out as providing the best task completion. The connector closely an 
smoothly follows the reference position and the limit cycles a ter assem y 
damped The Z forces also damp out after assembly. This experiment used V 
zTdffness of 1 8* Thus, the stiffness ratio, K z and is 1.0. If the force levels 
from these experiments are judged too high it would only be necessary to keep i the | same 
stiffness ratio and decrease both K, and A', so that the interface forces are acceptable. 
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Figure 4-24: Y Axis position and force time histories for experiment 1 
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Figure 4-26: Y Axis position and force time histories for experiment 2 
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Figure 4-27: Z Axis position and force time histories for experiment 2 
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Figure 4-28: Y Axis position and force time histories for experiment 3 
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Figure 4-29: Z Axis position and force time histories for experiment 3 
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Figure 4-31 : Z Axis position and force time histories for experiment 4 
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Figure 4-32: Y Axis position and force time histories for experiment 5 
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Figure 4-34: Y Axis position and force time histories for experiment 6 
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Figure 4-35: Z Axis position and force time histories for experiment 6 
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Chapter 5 

SYSTEM DESIGN ISSUES 


Once a preliminary set of static and dynamic performance requirements has been gener- 
ated, the system design process will use them and evaluate the various design options to 
find the set of design options which satisfy the requirements for the minimum cost. 

The manipulator design process is primarily concentrated in 3 disciplines: 

• Mechanical design and analysis, 

• Controller hardware/software design and analysis, 

• Control algorithm design and analysis. 

Within each of these diciplines there is a wide range of options which must be explored 
and evaluated against one another. In addition to these trade-offs it is vital to consider 
interdisciplinary trade-offs! For instance the controller hardware configuration will sig- 
nificantly impact the control algorithm complexity and controlled system performance. 
The control algorithm choice will affect the type and location of sensors which must be 
incorporated into the mechanical design. 

A third level of trade-offs must also be evaluated. This involves modifications to the 
performance requirements. For instance the functional requirement to assemble two parts 
without exceeding a given force level during the assembly can lead to a wide range of 
possible performance requirements — one could specify a very high level of positioning 
accuracy at the end-effector, and therefore be able to specify higher levels of stiffness 
for the end-effector impedance; or one could specify a lower end-effector positioning 
accuracy and use a low end-effector impedance specification to ensure that the forces due 
to potential misalignments remain acceptably low. 

In order to achieve this level of insight and optimization in the design of manipulation 
systems it is neccessary to develop the tools which will allow designers to see the effects 
of changes quickly and easily. We are developing the techniques and have previously 
developed crude prototype tools which have confirmed both their usefulness and more, 
their neccessity in developing a formalized approach to the manipulator design process.' 

Our investigation has concentrated on developing simple models which capture the 
key features of the system stability vs. system performance trade-off. For feedback 
control systems this is typically the critical issue — the system performance is limited by 
the system stability. We will describe our efforts to understand the fundamental properties 
which affect the stability of manipulator systems. Parameterizing and quantifying these 
relationships provides invaluable insight into the relative benefits of the various design 
options. 

We first describe analytical efforts to predict the stability of a single manipulator 
during force interaction tasks. Then we compare the results of these analytical efforts 



with experimental results, using one of the manipulators from the Dual Arm Testbed. 
We then examine the stability of a coordinated pair of manipulators, and compare t e 
predicted and experimental results. For these investigations we have again choosen very 
simple tasks, examining only one Cartesian degree of freedom. Finally we look at a more 
realistic task, the assembly of a NASA Space Station truss connector and show that the 
results from the simple tasks carry over into more complex ‘real-world tas s. 


5.1 System Stability In Contact with Environment 

It has been widely reported and our experience confirms that using active feedback 
of end-effector forces during force interaction tasks can have stability problems. The 
instability typically occurs when the end-effector comes in contact with the environment 
against which it is operating, ie. if the task is to assemble two parts the instability occurs 
when the two parts come in contact. 

We have been actively investigating this phenomenon for the past two years, at- 
tempting to understand the causes for the instability, and be able to predict its occurence. 
We have developed very simple dynamic model structures which preserve the fidelity of 
the manipulator/environment interaction, yet provide considerable insight into the causes 
of instability. The stability characteristics of the system result from a complex interaction 

between: 

• the environment dynamics, 

• the closed-loop joint dynamics, 

• the Cartesian impedance controller and associated Computational time delay. 

We will use an “Operational-Space” approach to developing the model of the manip- 
ulator closed-loop dynamics [DEP88]. This approach involves mapping the closed- loop 
joint dynamics from joint space into Cartesian space. In essence the dynamic structure 
of the joint dynamics is locally preserved during this transformation. That is if the joint- 
space inner-loop dynamics were second order for all the joints, then in Cartesian space, 
for small disturbances, the inner-loop dynamics will be second order. 


5.1.1 Stability of a Single Manipulator 

We will first examine the case where the computational time delay is zero. The resulting 
model of the system will be linear, time-invariant. This allows us to analytically derive 
a closed form expression for the stability characteristics of the system. 

We are interested in examining how the environmental dynamics will affect the 
stability of a manipulator in contact with the environment. By using an operational 
space approach we can obtain considerable insight by looking at a single Cartesian degree 
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of freedom. The closed loop position transfer function, G'(.s) along a single Cartesian 
direction, in free-space, is approximated by 



Kn 

Jm -S 2 + B m S + h m 


(5-1) 


where J m is the effective inertia, D m is the effective damping, and K m is the effective 
stiffness of the position dynamics. J m ,B m ,K m are all > 0. No assumptions are made 
as to the control structure which results in this closed loop transfer function. Notice also 
that this is a fairly general reperesentation of the position dynamics, since depending 
on the relative magnitudes of J m , B m , K m , the system behavior may range from a pure 
positioning device to a pure inertia. 

For this investigation the environment is modelled as an inertia connected to a 
parallel spring and damper system which is connected to inertial ground. The impedance 
of the environment Z c is described by 


Z f = — — J e s 2 + B, s + A ,, (5 2) 

A 

where F is the force applied to the environment, .V is the displacement of the environ- 
ment, J e is the inertia of the environment, B e is the damping of the environment, and I\ c 
is the spring stiffness of the environment. J e ,B e ,kK e are all greater or equal to zero. 

The environment dynamics will clearly impact the closed loop position dynamics of 
the system. The transfer function of the closed loop position dynamics, in contact with 
the environment can be written as 


X c J cq s 2 + B eq s + I\ eq ’ 

where: 

Jeq — ^ m T J e » 

Beq “ B m + B e , 

A eq — I\. Jfi ~ 1“ A 

Figure 1 shows the block diagram of the system in contact with the environment, 
and under impedance control. The position output A is multiplied by the environment 
impedance Z e , to obtain the force seen by the force sensor at the manipulator/environment 
interface. 

The force output from the force sensor F is filtered through a first order impedance 
filter H(s). The B and I\ in H(s) correspond to the desired damping and stiffness 
characteristics of the manipulator. Notice that if G(s) is a perfect positioning device, 
then the manipulator impedance would be exactly 


Z 7n — Bs + A . 


The output of the impedance filter H(s) is a position update X t , which is summed 
with the reference position X r , to form the commanded position A c . 



Figure 5-1: Block diagram of system in contact with environment. 


The open-loop transfer function, from A c to A„ is given by 

Pol(s) = — - — — m(d e S 2 -|- B C S -f l\ c ) 

AA ( J eq S 2 + B eq S + K eq )(Bs + K ) ' 


(5-4) 


Notice that if K e _ 0 then the maximum phase loss of the open loop transfer function 
wi e —ISO . Therefore the system will be stable for any value of KSzB > 0. Thus 
if the environment may be modelled as a combination of inertia and damping then the 
system will be stable for any KkB > 0. If I< e is not zero then the stability conditions 

are not as clear, and it is neccessary to examine the roots of the closed loop transfer 
function. K 

The closed loop transfer function, from X r to X, will be 

P cl (s) = = — ^-1 = A m ( Bs -f K) 

A r D(s) (J fq s 2 + h eqS + I< eq )(Bs + I<) -f K m (J e s 2 -f B e s + I< e )' 

The closed loop system will be stable IFF the roots of £>(») all have neuative real plm 
D{s) may be expanded to 

-D(-s) = .h„Bs 3 + ( J eq K + B eq B -f K m J e )s 2 

+ (Heq A + I\ eq B -f I\ m B e )s + (K eq K -\- K m K e ). (5-6) 

Using the appropriate substitutions, this may be rewritten as 

D{s) = qqs 3 + a l s 2 4- a 2 s + a 3 . (5 _ 7) 

T , J he f °. Uth cr ! tena may be a PP lied to (7) to determine whether the system is stable. 
The Routh Array for (7) is given by 


« 0 «2 
«l «3 

'■1 0 

/'2 0 


(5-8) 


5-^1 





where: 


__ a 1 02-00(1^ 

1 ai 

**2 = ^ = * 3 . 

The Routh criteria states that for a system to be stable, all of the elements of the 
first column of the Routh Array must have the same sign. 

One may satisfy oo, a \ , O all > 0 by requiring J m , Bhh > 0. All other parameters 
in a 0 ,fi] & r 2 are then required to be > 0. For the system to be stable it is additionally 
required that > 0. In examining r x notice that a x > 0 has already been required . 
Therefore it is sufficient to find conditions for 


a\(i2 — «o«3 > 0. (5 9) 

Refering back to (6), equation 9 may be expanded as 

{J eq B eq )I< 2 

+(J eq B e K m + B't q B + B er J e K m )I< 

+(B cq B + J e l\ m )(I\ eq B + B e K m ) — J eq Bh m I\ e > 0. (5-10) 

Equation 10 is quadratic in both K and B. It may be easily solved to find the values 
of K which satisfy this inequality. The minimum values of K which satisfy (10) are 
given by 


K > - 


(5-11) 


+ 


J eq B e K m + LI + B eq .J e l\ m 
^ J eq B gq 

(J eq B e K m + Bl q n + B eq J e K m ) 2 +4J eq B eq (J eq BK m K e - (H rq B + J r K m )(K eq II + B c K m J) 

( 2J eri B F „f 


The complexity of the expression for K notwithstanding, it is possible to glean useful 
information from (11). For instance if we look at the expression within the square root 
we see that if 

J eq Bf\ m K e < (B tl ,B + J e I\ m )(h eq B + B e I\ m ) (5 — 12) 

then the real part of the square root expression will be less than the negative part of (1 1). 
Therefore the allowable K from (11) will be less than zero. Since we have previously 
restricted K > 0, satisfying (12) ensures that for any B > 0, any K > 0 will result in a 
stable system. 

Figure 2 shows the stability boundaries of I< vs. B for a pure stiffness environment. 
The region below each of the curves is the region of unstable impedance specifications, 
for that environmental stiffness. Notice that as the environment stiffness increases, the 
region of unstable impedance specifications increases dramatically. 

Figure 3 shows the stabilizing effect of adding inertia to the environment. The 
environment is modelled as a stiffness and inertia. Again the region below each curve 
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Figure 5-3: Stabilizing Effect of Environment Inertia. 

corresponds to the region of unstable impedance specifications, for the particular environ- 
ment dynamics. As the environment inertia increases, the region of unstable impedance 
specifications decreases. Relatively small amounts of inertia can have a dramatic impact 
on the system stability characteristics. 

Adding damping to the environment will likewise tend to stabilize the system. We 
have limited our discussion to stiffness and inertial environments since we feel that these 
are the predominant dynamic characteristics in the majority of force interaction tasks. 
The extension of these results to other environments is straightforward. 

It is critical to recognize that this analysis shows that even for a manipulator with 
zero computational time delay, the combination of manipulator and environment 
can cause the manipulator to go unstable! For the case shown here, two possible 
solutions to reduce the unstable region are: 

1 to add inertia to the end-effector. This may not be practical since adding inertia at 
the end-effector greatly increases the torque requirements at all the joints back to 
the base - thus increasing system weight and power requirements. 

2 to add compliance to the end-effector. For instance, if the environment stiffness was 
1000 Nt/cm, it would be impossible to achieve an impedance of Ii = lONt/cm and 
B _ \ &i=2S& ' However if the end-effector was designed to have a stiffness of 50 
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Nt/cm, between the force sensor and the environment, the effective environment 
stiffness would be the series combination of the end-effector stiffness and the 
environment stiffness - therefore allowing us to achieve the desired impedance 
specification. 

Effect of Computational Time Delay on System Stability 

When a computational delay is included in the analysis it has a dramatic impact on the 
stability characteristics of the system. The computational delay has the effect of adding 
phase loss to the open-loop transfer function (4). The phase loss from the computational 
time delay will be function of frequency and is described by 

. 180 

4>Jly = W>/;« v , (5 - 13) 

7T 

where: 

4>di y is the phase loss in degrees, 
u> is the frequency in rad/scc, 

Tjiy is the computational delay in seconds. 

The computational delay thus lowers the frequency at which the phase crosses the 
180° line. This then requires that the open-loop magnitude must cross the 0 dB line at a 
lower frequency to maintain closed-loop system stability. 

Figure 4 shows the modelled system including the computational delay. The stability 
boundary for this system, in terms of the impedance specification B and K, occurs at the 
combination of B and I\ values which cause the open-loop transfer function to have zero 
gain and phase margin. Finding a closed form solution for this point is all but impossible, 
since it involves solving a set of coupled, trancendental equations (the expressions for 
the gain and phase of the open-loop system including time delay). However numerical 
optimization techniques can be employed to solve these equations, and find the stability 
boundary. 

We are developing techniques and a prototype stability analysis package which 
will automate the determination of allowable impedance specifications, based on system 
stability. Figures 2 and 3, presented earlier, and 5 were generated using these techniques. 
Figure 5 shows the severely destabilizing effect of time delay. As the time delay is 
increased to 0.1 seconds, the minimum allowable impedance specification increases by a 
factor of 2, from the zero time delay case (Figure 3). 

Experimental Verification of Analysis 

The results using the simplified models discussed here have been verified against hard- 
ware results from our Dual Arm Testbed. Using one of the manipulators, a spring was 
attached between its end-effector force/torque sensor and ground. This spring served as 
the environment dynamics. The stiffness and damping specification of the impedance 
filter was adjusted to find the stability boundary. 
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Figure 5-6: Comparison of predicted and actual stability boundary. 


The time delay in the Cartesian impedance loop was then measured, and the closed 
loop joint dynamics identified. Using these results we computed the predicted stability 
boundary and compared it to the actual stability boundary. This comparison is shown in 
figure 6. The two show excellent agreement. 


5.1.2 Stability for Coordinated Dual Arm Tasks 

For coordinated dual arm tasks the stability question is much more complicated. One 
must still consider the effect of the external environment dynamics on the stability of each 
manipulator. In addition one must examine the effect of one manipulator on the stability 
of the other, taking into account the dynamics of any connecting structure between them. 

We have investigated the validity of extending our analysis, using the simplified 
models of the system dynamics described earlier, to the coordinated dual arm case. 
Currently we have only considered the effect of one manipulator on the stability of the 
other, where the connecting structure is modelled as a pure spring. For this case the 
effective environment impedance, as seen by each of the manipulators, is simply the 

senes combination of the connecting spring stiffness, and the end-effector impedance of 
the other manipulator. 

Consider first the case with zero computational time delay. It is possible to derive 
the closed form analytic solutions for the system stability characteristics, following the 
same procedure used for the single arm case. It is only neccessary to supplement the 
expression for the environment dynamics with the closed-loop dynamics of the connected 
manipulator. Keep in mind that the resulting expression for system stability would be 
extremely complicated and it is not at all obvious that it would yield any useful insight 
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Figure 5-7: Block diagram of dynamic model for coordinated dual arm system. 

into the problem. For that reason we have not attempted the algebra here. 

When time delay is considered, numerical methods must again be employed to solve 
for the stability characteristics. These numerical techniques may then be tailored to allow 
parametric studies into how various system parameters (such as amount of time delay, 
dynamics of connecting structure, manipulator position dynamics) affect system stability. 
These studies can then be used to initiate further analytical investigations. 

Using the simple models developed for the single arm stability analysis, we have 
simulated the response of the dual arm system and attempted to predict the stability 
boundary. Figure 7 is the block diagram of the dynamic model of the two manipulators 
interconnected by a spring of stiffness 18.4 lb/in. The manipulator dynamics are those of 
our Dual Arm Testbed, and both manipultors are considered to have identical dynamics. 
In addition the time delays in the two systems are identical, and the same impedance 
specifications were used in both manipulators. 

Figure 8 compares the predicted stability boundary to the experimentally measured 
boundary. Again there is good agreement between the two. Notice that for this case the 
manipulators definitely have a destabilizing effect on one another. The region of unstable 
impedance specifcations has been pushed out by about a factor of two from the single 
arm case (Figure 6). 
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Figure 5-8: Comparison of predicted and actual stability boundary for dual arm case. 
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5.2 System Stability For Truss Connector Assembly Task 

We have developed and verified techniques for predicting system stability charac- 
teristics using very simple environment dynamics. We now wish to examine how useful 
these simple models are in understanding the stability and performance characteristics 
for more complex ‘real-world’ tasks. To examine this issue we used the truss connec- 
tor task, described in section 4.3 of this report. Using the same test setup as for the 
X axis misalignment experiments (see section 4.3.2), we reduced the Cartesian transla- 
tional impedance specifications on Robot 1 until we approached the stability boundary, 
and Robot 1 was marginally unstable. We then first increased the stiffness specification 
to see its effect on stabilizing the system. Following this we increased the damping 
specification to examine its impact on system stability. 

For the first experiment the damping of the Cartesian translational axes was set at 
R „ = 0 54 w-* ec . The stiffness specifications for the X and Z axes were K r = 0.81 AO/cm 
and K z = 0.27 Nt/ cm. Figure 9 shows the position and force time histories along the 
X axis. Notice that after the connector halves are mated a strong limit cycle develops, 
resulting in peak forces of 6 Nt. This force level was high enough to cause movement 
of the connector in the end-effector jaws. 

The stiffness of both the A' and Z axes were doubled for experiment 2, to K x = 

1 .62 N t /cm and K z - O.MNt/cm. Figure 10 shows the X axis time histories for this 
experiment. The results are virtually the same as experiment 1, with the peak force 
remaining at 6 Nt. 

For experiment 3 the stiffness specifications for the X and Z axes were doubled 
from experiment 2, to K x — 3.24 AO / cm and I\ z - 1.08 Ntjcm. Figure 11 shows the 
X axis position and force time histories. After quadrupling the stiffness specifications, 
from their original values, we finally see some improvement in system stability. The 
limit cycles are slightly reduced, and the peak force has been reduced to 4 Nt. 

The next experiments examined the effect of the damping specification on system sta- 
bility. Experiments 4-6 used X and Z axis stiffness specifications of K x = \ .62Nt/cm 
and I\ z = 11.54 Nt/ cm. 

In experiment 4 the translational axes damping specification was increased to B Xi VyZ — 
0.63 —-* —. Figure 12 shows the A' axis response. The limit cycles have been dramat- 
ically reduced from those of experiment 2 (Figure 10), which used the same stiffness 
specification and a damping specification of B XtV<z = 0.54 Nt ~ l s l ec - The peak forces for 
experiment 4 have been reduced to 2.5 Nt, which is less than half of those recorded for 
experiment 2 . 

Experiment 5 used a damping specification of B x ^ hZ = 0.72 Aft c ~* --. Figure 13 
shows the X axis time histories. The peak force has been further reduced to below 
1.5 Nt. 

The damping specification for experiment 6 was increased to B Tty z — 0.81 /V ' c j n 5ec - 
Figure 14 shows the A' axis time histories. The limit cycles have been reduced to slightly 
over 1 mm and the peak force is only 0.8 Nt. Thus increasing the damping specification 
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by 50% has led to a reduction in peak forces by a factor of 7.5. 

From these experiments it is clear that the system stability characteristics are much 
more sensitive to the damping specification than to the stiffness specification. A 400% 
increase in stiffness specification caused a 33% reduction in peak force, while a 15% 
increase in damping specification caused a 50% reduction in peak force. 

These results are very consistent with those seen using the very simple environment. 
Looking again at Figure 6 we see that the slope of the stability boundary near the I< = 0 
crossover is fairly steep. Therefore the system stability will be much more sensitive to 
changes in damping specification, B, than to changes in stiffness specification, K, in this 
region. 
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Figure 5-9: X Axis position and force time histories for experiment 1, 
B x , y , z = 0.54^, I< x = O.Sl£, K y = 0.27S. 
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Figure 5-10: X Axis position and force time histories for experiment 2, 

U _ 0 KA ^t-sec K _ 1 QoXL - 0 54 —. 
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Figure 5-12: X Axis position and force time histories for experiment 4, 

n - 0 Nt^sec T' 1 c^Nt r- q 54 ^ 

*>x,y,z ~ U -°'J cm ’ ~ i * u “ C m’ V cm' 
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Figure 5-14: X Axis position and force time histories for experiment 6, 
n =0 8 1 ^ f ~ scc J\ — 1 f*' — n x^aNA 

X } y y Z ’ rm f ^ 


1 . 62 —, Ky = 0 . 54 —. 

cm y cm 


5-20 



Chapter 6 

VERIFICATION OF MANIPULATOR 

IMPEDANCE 


This chapter describes an approach to determining achieved manipulator mechanical 
impedances which result from various control implementations. Identifying these impedance 
is important when impedance control is implemented, so that the actual system behavior 
can be compared with design goals. Such comparison provides the detailed, quantitive 
data necessary to determine when certain impedance objectives can be achieved, and 
what system components cause performance limitations. Even when impedance control 
is not used, that is, when the performance specification is not explicitly in terms of 
impedances, an identification of the achieved impedances can help in understanding the 
performance capabilities of the manipulator. This is especially true when the task in- 
volves environmental contact, and the environment is not highly structured or accurately 
known. 


6.1 Mechanical Impedance Terminology and Notation 

For any particular manipulator and associated controller, limitations exist in the 
ability to achieve various levels of stiffness, or more generally, various mechanical 
impedances. A proper understanding of these limitations depends on the ability to 
measure and quantify actual manipulator impedances. This report describes a general 
identification technique for achieved impedances which can be used on any robot system, 
controlled by any controller. 

Mechanical impedance is defined as the relation between positions and forces at 
some point on a system. In general, it is a non-linear dynamic relation which may be 
quite complicated [HOG85], When this relation exists as a single valued function in some 
region, an impedance and/or admittance function exists. When these functions are smooth 
enough so that derivatives exist, and the first derivatives are non zero, then impedance and 
admittance functions both exist and are inverses of one another (inverse function theorem). 
As a practical matter, most impedance relations satisfy these smoothness conditions, or 
can be closely approximated by sufficiently smooth impedance or admittance functions. 
Moreover, an impedance specification is likely to be as simple as possible (ie. as simple as 
necessary to complete a manipulation task). Thus, linear impedances will be considered 
exclusively in this report. This of course is a good local approximation if the desired 
impedance is slowly varying as a function of manipulator position. 

We will consider an impedance specification which captures the dominant effects ot 
stiffness, damping, and inertia. This is a necessary level of complexity, and additional 
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detail in this specification could be considered as needed in later studies. When this 
impedance relation is linear, it takes the form 

dX J 2 X 

F = KX + »_ + 1— 

where I<, B, and J are the stiffness, damping, and inertia matricies, respectively. F 
is the vector of cartesian forces and torques acting at the point in question, and A is 
the vector of cartesian positions and orientations, also measured at the point in question. 
(We will assume throughout that orientations are represented in the euler axis-angle form. 
Although this is not the most convenient representation for actual control implementation, 
straightforward transformantions exist from this form to quaternion and direction cosine 
matricies.) A mechanical system has certain restrictions on the impedance parameters. 
For example, the parameters must be “non-negative , and they have a specia structure 
(thev are symmetric). With feedback control, however, “unnatural” impedances can be 
constructed, even “negative” ones. However, until a need for more complex structure in 
these matrices is demonstrated by experience on real tasks, we will assume that they are 
all diagonal. This implies that the impedance specifications in each cartesian degree of 
freedom are independent from any other. This causes the impedance description above 
to simplify to the scalar equation 

dx . (I 2 x 

f = k.v + h-~ X J-TX 


along each cartesian direction. 

The above linear, decoupled impedance is only a specification or a goa . or a y 
particular manipulator under a specific control scheme, the probability is great that this 
desired impedance is not achieved precisely. In fact the controlled system may be un- 
stable in the presence of certain properties of the environment, manipulator, or control 
parameters. See [LAW87,LAW88] for studies of impedance control stability properties. 
Assuming that the controlled system is stable, the performance of the closed loop system 
must be measured to determine the success of a particular control scheme. Here, perfor- 
mance is measured as the degree to which the desired impedance goal is achieved. That 
is, measured manipulator impedances resulting from feedback control will be directly 
compared to the impedance specifications used in control design. 

Some portions of the manipulator impedance can be directly measured. For example, 
the stiffness k in a particular direction is relatively easy to measure using a force gauge an 
ruler However, the damping and inertial terms are difficult to measure, since constant 
velocity or acceleration sources would be required for direct measurement. Another 
approach is taken here. Since the impedance is a dynamic function which is supposed 
to be linear, frequency domain techniques will be used. Measurements of position and 
orientation, together with forces and torques in each Cartesian direction of interest are 
recorded as time series. Offline computations of the Fourier transforms of these signals 
are computed and “divided” to form the transfer functions relating positions (inputs) to 
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forces (outputs), which is the frequency domain representation of impedance These 
transfer functions are typically represented separately as magnitude and phase functions 
of frequency, although pole and zero representations are sometimes useful. 

Consider the following impedance specification along a particular degree of freedo 

f(s) = (k + bs+js 2 )x{s) ( 6 - 1 ) 

in the frequency domain. The transfer function f(s)/x(s) is the impedance along this 
axis, which has the general frequency response characteristics shown in Figure 1-1. Note 
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Figure 6-1: Magnitude and phase of the impedance specification k + bs + js 2 . 

that the DC value of the magnitude of the impedance is the stiffness k. As the frequency 

increases, damping terms dominate, followed by domination by de^The phase 
frequencies, the slope of the magnitude function approaches 40 dB/decade. The p . 

function begins at zero and increases to +tt radians, or +180 degrees. 

The measurement of actual impedance should closely correspond to the curves of 
Figure 1, when the corresponding desired and programmed impedance parameters k b, 
and j are used. This can be checked along each Cartesian degree of freedom individually. 
Even if these curves are similar, the actual performance may not be similar to the desired 
performance. What are missing are the “cross impedances”, those relations between one 
Cartesian direction’s force and another’s position. Since the impedance objectives are 
decoupled between these axes (in this report at least), the measured cross impedances 
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should be zero. Practically, they will not be precisely zero, particularly as frequencies 
increase. At high frequencies, the control designed to implement the desired objective 
typically is less effective due to actuator torque/speed limits. Thus, the measured cross 
impedance can be expected to be small for low frequencies (small magnitude and phase), 
and magnitudes and/or phases may increase at higher frequencies. The “bandwidth” 
of the region where the cross impedance is small, as well as the “size” of the cross 
impedance can be used as a measure of the degree of decoupling actually achieved. 

For a characterization of all six Cartesian degrees of freedom, then, a complete 
measurement of the manipulator’s achieved impedance would consist of a set of 36 
transfer functions. For a real mechanical system, the impedance is always symmetric, 
i.e. the impedance from an axis x to another axis y is always the same as the impedance 
from the y axis to the x. In this case, the impedance matrix is symmetric, and only 21 
unique impedances are possible. However mechanically non-realizeable impedances are 
possible using feedback control, so all 36 impedances are necessary in general. 

The above impedance measurements are assumed to take place in the neighborhood 
of zero environmental interaction. When large forces occur as a result of deflecting the 
manipulator well away from this “impedance center”, nonlinear effects due to torque 
saturation and manipulator kinematics may cause significant deviations from the linear 
impedance objectives. Although for some tasks this behavior is also of interest, it cannot 
be expected to match the simple linear impedance specification. In other words, the 
impedance measurements above are derived from “small signal” motion responses. ' 

Having described the necessary quantities to measure, we now turn to a discussion of 
ways to obtain these measurements. What we have is essentially a multivariable system 
identification problem. All 36 elements in the impedance matrix must be identified using 
only 12 Cartesion signal measurements (six positions/orientations and six forces/torques). 
In principle, the easist way would be to allow motion in only one axis at a time, but 
measure the resulting forces along all axes. This would fill out one column of the 
impedance matrix at a time. A dual approach would be to allow forces only in one 
direction, while measuring resulting positions in all axes. This would fill out one row of 
the impedance matrix at a time. Both these simple approaches require a special fixture 
at the point where impedance is to be measured. The first is very rigid, except for one 
Cartesian position or orientation at a time. The second has “zero rigidity”, i.e. can 
support no forces (both static and dynamic) in all axes but one, at any one time. Even 
though this is a conceptually simple approach, it may be quite difficult to carry out in 
practice. 

A conceptually more difficult approach would be to excite motion in all axes at 
once, and measure all resulting forces at once, then combine all these measurements to 
obtain the full impedance matrix in one step. This would certainly be easier to achieve 
mechanically, since no special fixtures would be required. However, the impedance 
matrix may not be adequately ‘filled”, since there are fewer measurements than there are 
variables to determine. 
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Figure 6-2: Experimental setup for impedance measurement tests. 


6.2 Experimental Test and Test Objectives 


To confirm our ability to measure impedances a simple test was developed using the 
T 3 - 726 Dual Arm Test-Bed. The test objectives were to individually identify both the 
end-effector impedance of robot arm 1 and the environment impedance (along a single 
Cartesian direction). 

The test setup is shown in Figure 2. A fixture with a known stiffness in the X 
direction, and virtually zero stiffness in all other Cartesian axes, was connected between 
the force sensors of the two robots. 

Robot arm 1 had low impedances programmed in at least the X direction for all the 
tests (low impedances were specified in all axes for some tests). Robot arm 2 had large 
impedances programmmed in all axes, thus robot arm 2 behaved very similarly to a pure 
position source. 

Figure 3 shows a simplified block diagram of the robot arm 1 dynamics along the 
X axis. Notice that there are two possible sources of input signal, either X r or X 2 . X,. 
is the standard reference position input to robot 1 , X 2 is a disturbance input from robot 
2. The effect of the X 2 input is to cause a force disturbance on the end-effector force 
sensor equal to f s = (A^ — X 2 )K e . 

If X r is zero and the system excitation is from X 2 , then the transfer function from 
f s to X\ will be the inverse of the impedance of robot arm 1. That is 


H(s)G{s) 


( 0 - 2 ) 


If G(s) has a much higher bandwidth than H(s), and if K m K e , then at frequencies 
below the bandwidth of G'(s) the manipulator impedance Z\ x should closely approximate 
that specified in H(s). 
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Figure 6-3: Block diagram of Robot 1 in contact with Robot 2 through spring environment 
of stiffness K e . 

If X 2 is constant and the system excitation is from X T , then examining the transfer 
function from A' to f s will identify the environment impedance. 


Notice that to identify different impedances we are using identical measurements, but 
different excitation sources. To measure the end-effector impedance we would ideally use 
a force source at the end-effector force sensor. To measure the environment impedance 
we would ideally use a reference position source. 


6.3 Experimental Test Results 

The results from the experimental tests are presented as a series of frequency re- 
sponse plots from an HP 3562 A Dynamic Signal Analyzer. The ‘swept-sine’ input source 
from the signal analyzer was used for the excitation signal in all the tests. The measure- 
ment signals from which the various frequency response plots were calculated were taken 
off the D/A ports on the digital robot controllers. The effect of the digital controllers 
can be seen in the higher frequency part of the frequency response plots. At the upper 
frequencies the curves become very choppy. The position control loop is running at 33 
Hz. Thus the maximum frequency at which the measured data will closely approximate 

a continuous signal is between 3 and 5 Hz. 

Figure 4 shows the closed loop transfer function from X T to A' when the environ- 
mental contact is zero. This corresponds to G{s) from Figure 3. The bandwidth of G(s) 
is approx. 4.5 Hz. 
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The environment impedance was identified by inputting a swept sine signal at X r 
and looking at the transfer function from X r to f s . Figure 5 shows the frequency response 
of this tranfer function. While the magnitude is not very smooth, its average value over 
the frequency range 0.1 - 5.0 Hz is approximately 33.8 dB which corresponds to an 
environmental stiffness of 48.9 lb/in. This stiffness compares well with the measured 

stiffness of the spring fixture of 50 lb/in ( + /_ 5 ^). 

The maniulator impedance was identified by inputting a swept sine signal at X > 
(using robot 2), and looking at the transfer function from X to f s . For the first test, the 
stiffness and damping of the first robot were set to 3 lb/in and 3 lb-sec/in, respectively, 
in the X direction, and to 20 lb/in and 20 lb-sec/in, respectively, in all other axes. 
Figure 6 shows the frequency response of this transfer function. The dashed line below the 
magnitude curve is the predicted magnitude based only on the impedance specification. 
The marker at approximately 1.3 Hz indicates the frequency beyond which the data 
coherence is poor. Up to this 1.3 Hz marker there is good agreeement between the 
actual impedance and the specified impedance. The magnitude shows a definite first 
order characteristic, and the gain is shifted by only 2 dB from the predicted value. The 
35° phase shift over 1 Hz corresponds to a time delay of 0.097 seconds, which is very 
close to the measured time delay in the force data of 0.08-0.09 seconds. 

For the second case the manipulator impedance specification was set at 3 lb/in and 
3 lb-sec/in in all Cartesian axes. The manipulator impedance was identified in the same 
manner as above. Figure 7 shows the frequency response for this case. The results are 
virtually identical to those shown in Figure 6. 
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Figure 6-6: Identification of manipula 
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The experiments described above show lhat is indeed possible to measure the dy- 
namic characteristics of both the manipulator and the environment Both .the • 
stiffness and the mampulator impedance were accurately measured at low ^requeue bs 
T he experiments also demonstrated the need for much more sophisticated _te l fa- 
cilities than were used here. The 80-90 ms. delay in the force data made it dtfficu 

internret the force data at frequencies above 2-3 Hz. . 

Z measure the impedance of the manipulator, the ideal measurement techntque 

would use a pure force source to excite the manipulator at the end-effec or, 
measurements would be taken from a combination force/torque sensor and inertial position 
“"here .he measurement data is either analog, or sampled at a frequency above 
1000 Hz. The sensor would be attached at the point through which the manipulate . 

bei " Tot'eture the impedance of the environment, the ideal measurement technique 
would use a pure position source to excite the environment, and measurements would 
taken from the same sensor used above, with the sensor now attached to the environment. 

The ability to measure the Cartesian impedance of the manipulator, even in 
rudimentary fashion shown here, demonstrates a key technology in the thrust to deve op 
manipulator systems which are designed to meet predefined dynamic requirements. 
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Chapter 7 

CONCLUSION 


This report has described a methodology which, if implemented, would advance mamp- 

- 

in three primary areas before this methodology 

is fully matured. These are: 

• definition of performance requirements . 

For the near term, performance requirements will be primanly f denied ^ 
i mental testing As a large database of requirements for difficult tasks is developed 
“Itn begin on analytical methods to general the rest,,, m the database. 
This may be a fruitful application for an expert system. 

# exam^nadon cflltets of different control structures and the use of more com- 

plex impedance specifications, 

* Applicmuln of sL't^ofdh"^ recursive system identification techniques to the idem 
tification of both manipulator and environmental impedances. This approach would 
obviate the need for expensive laboratory test fixtunng to measure impedances, a 
toM allow for a compact, portable testing system suitable for use m the opera, mg 

environment. 

The application of this, or a similar methodology for manipulator design, devel- 
opment and testing is vital for the development of reliable man, pula, or systems a, an 

affordable cost. 
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